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Control of the positioning of a robot type handling device with optical sensors is improved by storage of future 
movement points in memory to enable the robot to follow a path more quickly with no loss of positioning 
accuracy r 
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Prufungsantrag gem. § 44 PatG ist gestellt 

® Verfahren und Vorrichtung zur Regelung der Vorhalteposition eines Manipulators eines Handhabungsgerats 
(§) Die Erfindung betrifft ein Verfahren zur Regelung der 

Vorhalteposition eines in mehreren Freiheitsgraden be- 

wegbaren Manipulators (2) eines Handhabungsgerats <1) 

relativ zu einem Objekt (3) entlang einer Verfahrbahn. Urn 

eine schnellere Regelung der Vorhalteposition zu ermdg- 

lichen, wird vorgeschlagen, dass mehrere Punkte zumiri- 

dest eines Teils der Ist-Verfahrbahn gespeichert sind und 

fur eine vorausschauende Regelung der Vorhalteposition 

des Manipulators (2) entlang dieses Teils der Verfahrbahn 

herangezogen warden. 
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Beschreibung Regeiung der \orhalteposition mussen die Sensorcn in ei- 

nen konkreten Bezug zu dem Manipulator und zu dem Ob- 
Die voriiegende Erfindung betrifft ein Verfahren und eine jekt gebracht werden (Einrichten) und die Parameter der Re- 
Vorrichtung zur Regeiung der Vorhalteposition eines in gelung an den konkreten Bezug angepasst werden (Kalibrie- 
mehreren Freiheitsgraden bewegbaren Manipulators eines 5 ren). Der Bezug der Sensoren zu dem Manipulator kann sich 
Handhabungsgerats relaliv zu einem Objekt entlang einer aufgrund von Temperaturschwankungen, mechanischen 
Verfahrbahn. Die Erfindung betrifft auBerdem ein Handha- Einwirkungen auf die Sensoren oder den Manipulator, o. a. 
bungsgerat mit einem in mehreren Freiheitsgraden beweg- verandern, wodurch ein eroeutes Kalibrieren und u. U. sogar 
baren Manipulator, dessen \brhalteposition relativ zu einem eine emeutes Einrichten der \forrichtung zur Durchfuhrung 
Objekt regelbar ist 10 der Regeiung notwendig wird. Wahrend des Einrichtens und 

Das Handhabungsgerat ist bspw. als ein mehrgeienkiger Kalibrierens steht die Vorrichtung nicht fur eine Regeiung 
Industne-Roboter ausgebildet Derartige Industrie-Roboter zur Verfugung, die Regeiung der Vorhalteposition muss un- 
werden insbesondere in der Automobilindustrie in der Ferti- terbrochen werden. 

gung und der Qualitatssicherung eingesetzt Fur die unter- Samtliche bekannten Verfahren zur Regeiung der Vorhalt- 
schiedlichen Einsatzmdglichkeiten eines Industrie-Roboters 15 eposition des Manipulators haben auBerdem den Nachteil, 
kann der Manipulator beliebig ausgebildet seia dass die Verfahrgescbwindigkeit des Manipulators relativ 

Der Manipulator ist bspw. als ein Werkzeug, insbesondere klein ist, da die Regeiung in Unkenntnis der bevorstehen- 
als ein SchweiBgerat, als ein Gerat zum Auftragen von den, zu regelnden Verfahrbahn des Manipulators erfolgL 
Klebstoff, von Faroe oder von anderen Beschichtungen auf Deshalb muss die Verfahrgescbwindigkeit so klein gewahlt 
eineOberflache f akemBearbeimngsgerato.a.ausgebU^ 20 werden, dass auch im Extremfall einer Verfahrrichtungsum- 
Zum Ergreifen eines oder mehrerer Objekte kann der Mani- kehr eine rasche und genau Positionierung des Manipulators 
pulator als ein Greifer, ein Saugnapf o. a. ausgebildet sein. sichergesteUt werden kann. Bei einer zu hohen Verfahrge- 
SchlieBlich ist es denkbar, dass der Manipulator als ein schwindigkeit wiirde der Manipulator bei stark gekrummten 
Messkopf z. B. zum Messen des Oberflachenverlaufs eines Verfahrbahnen oder einer Ve^ahrrichtungsumkehr aufgrund 
Objekts, einer Spaltbreite, eines Spaltversatzes, einer 25 der Massentragheit iiber die geregelte Verfahrbahn hinaus- 
Schichtdicke o. a. ausgebildet ist. schieBen und somit die geregelte Verfahrbahn verlassen 

Danut der Mampulator die ihm zugedachte Aufgabe er- Es ist deshalb eine Aufgabe der vorliegenden Erfindung 
fullen kann, muss er in eine definierte Vorhalteposition rela- ein Verfahren der eingangs genannten Art dahingehend aus- 
tiv zu einem Objekt gebracht werden. Unter dem Begriff zugestalten und weiterzubilden, dass eine moglichst 
Vorhalteposmon wird gemaB dem vorliegenden Patent so- 30 schneUe Regeiung der Vorhalteposition erreicht und dass 
wohl die Positionierung als auch die Ausrichtung des Mani- insbesondere hohere Verfahrgeschwindigkeiten des Mani- 
pulators relauv zu dem Objekt verstanden. pulators auf der \ferfahrbahn realisiert werden konnen, ohne 
Aus dem Stand der Technik smd Handhabungsgerate be- dass es zu einem Verlust an Regelungsgenauigkeit kommL 
kannt, die eine interne Steuerungseinrichtung aufweisen. Zur Losung dieser Aufgabe schlagt die Erfindung ausge- 
Auf der Steuerungseinrichtung ist ein Steuerungsprogramm 35 hend von dem Verfahren der eingangs genannten Art vor 
lauffahig, durch das der Mampulator endang einer program- dass mehrere Punkte zumindest eines Teils der Ist- Verfahr- 
mierten Verfahrbahn in die Vorhalteposition bewegt werden bahn gespeichert sind und rur eine vorausschauende Rege- 
kann. Wenn das Objekt stets an derselben Position angeord- lung der Vorhalteposition des Manipulators entlang dieses 
net ist, reicht eine solche Steuerung der Verfahrbahn bis zur Teiis der Verfahrbahn herangezogen werden 
Vorhalteposition vollkommen aus. Falls die Position des 40 ErfindungsgemaB ist erkannt worden, dass die Regeiung 
Objekts jedoch gewissen Schwankungen unterworfen ist, der Vorhalteposition durch eine vorausschauende Regeiung 
was der Regelfall ist, kann durch eine Steuerung alleine auf einfache Weiseentscheidend beschleunigt werden kann 
nicht mehr sichergesteUt werden, dass eine bestimmte Vbr- Wahrend der vorausschauenden Regeiung der Vbrhaltepos- 
halteposition des Manipulators relativ zu dem Objekt stets ition wird der bevorstehende Verlauf der Verfahrbahn be- 
mit der erforderiichen Genauigkeit eingenommen wird. 45 rQcksichtigt. Wenn der bevorstehende Verlauf der Verfahr- 
Schwankungen der PosiUon des Objekts konnen vielertei bahn es zulasst, bspw. bei einer geraden oder einer nur ge- 
Ursachen haben. ringfugig gekrummten Verfahrbahn, kann die Verfahrge- 
Um sicherzusteUen, dass die Vorhalteposition des Mani- schwindigkeit des Manipulators hoch gewahlt werden Da- 
pulators relativ zu dem Objekt auch bei Schwankungen der durch kann die Regeiung der Vorhalteposition entlang einer 
Position des Objekts stets mit der geforderten Genauigkeit 50 Verfahrbahn entscheidend beschleunigt werden Bei zuneh- 
eingenommen wind, ist es aus dem Stand der Technik eben- mender Krummung der bevorstehenden Verfahrbahn muss 
falls bekannt, die Vorhalteposition des Manipulators relativ die Verfahrgeschwindigkeit zunehmend reduziert werden 
zu dem Objekt zu regeln. Aus dem Stand der Technik sind Durch die Wahl einer geringen Verfahrgeschwindigkeit bei 
unterschiedliche Verfahren zur Regeiung der Vorhaltepos- starken Kriimmungen der bevorstehenden Verfahrbahn kann 
mon des Manipulators bekannt Diese bekannten Verfahren 55 zudem die Genauigkeit der Regeiung der Vorhalteposition 
zur Regeiung der Vorhalteposition sind jedoch sehr kompli- des Manipulators endang der Verfahrbahn entscheidend er- 
ziert und langsam. h6hl werden. Bei dem erfindungsgemaBen verfahren kann 
Im Rahmen der Regeiung der VbrhaUeposition des Mani- die Verfahrgeschwindigkeit somit dem Verlauf der bevorste- 
pulators relativ zu einem Objekt wird die Ist- Vorhaltepos- henden Verfahrbahn individual angepasst werden. 
mon des Manipulators zunachst mittels Sensoren erfasst und 60 Die Punkte der Ist- Verfahrbahn konnen auf unterschiedli- 
dann auf eine SoU- Vorhalteposition geregelL Die Sensoren che Weise, z. B. empirisch, simulativ oder durch Berech- 
sind bspw. als optiscbe oder als taktile Sensoren ausgebildet. nung, bestimmt werden. Bei der ernpirischen Bestimmung 
Insbesondere sind sie als Laser-Sensoren zum Messen der Punkte der Ist- Verfahrbahn konnen die einzelnen Punkte 
von Abstanden, als Kraft/Momenten-Sensoren zum Messen entweder mit dem Manipulator des Handhabungsgerats ma- 
von Kraften bzw. Momenten oder als Beriihrungssensoren 65 nuell oder von einer ersten Steuereinrichtung gesteuert an- 
zur Detektion einer Beruhrung mit dem Objekt ausgebildet gefahren werden. Bei der simulativen Bestimmung der 
Die Sensoren sind in einem bestimmten Bezug (Position Punkte wird zunachst ein Modell des Handhabungsgerats 
und Ausnchtung) zu dem Manipulator angeordneL Vbr der und des Objekts, vorzugsweise auf einem Computer, er- 
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stellt Anhand dieses Modells wind dann durch Simulation Punkte der Ist- Verfahrbahn aufgenommen und gespeichert 

der Verfahrbahn die Ist-Verfahrbaha bestimmL Bei der ma- (Record-Mode) oder die Vorhalteposition Vorausschauend 

thematischen Bercchnung der Punkte der 1st- Verfahrbahn geregeU (Operation-Mode). 

wird zunachst ein mathematisches Modell des Handha- In einer anderen vorteilbaften Weiterbildung der Erfin- 
bungsgerats und des Objekts erstellt, und die Punkte werden 5 dung wird vorgeschlagen, dass vor der Regelung der Vbr- 
dann durch Losen mathematischer Gleichungen berechnet halteposition die Soli- Vbrhalteposition des Manipulators an- 
GemaB einer vorteilbaften Weiterbildung der Vorliegen- gef ahren wird, wahrend einer Veranderung der Soll-Vorhalt- 
den Erfindung wird vorgeschlagen, dass die 1st- Verfahrbahn eposition um jeweils einen Freiheitsgrad Messdaten, durch 
des Manipulators vor der Regelung der Nforhalteposition ab- die die M)rhalteposition des Manipulators charakterisiert ist, 
gefahren wird und dabei die Punkte zurhindest eines Teils 10 aufgenommen und gespeichert werden und die Regelung 
der Ist- Verfahrbahn aufgenommen und abgespeichert wer- der Vorhalteposition in Abhangigkeit von den Messdaten 
den. Die Ist- Verfahrbahn muss nicht mit besonders hohen durchgefuhrt wird Zwischen den aufgenommenen Messda- 
Anforderungen an die Genauigkeit abgefahren werden, da ten und der Position des Manipulators besteht ein Zusam- 
die Verfahrbahn im Rahmen der nachfolgenden Regelung menhang. Somit sind in den aufgenommenen Messdaten In- 
der Verfahrbahn des Manipulators korrigiert werden kann. 15 formationen uber die Position des Manipulators enthalten. 
Die abgefahrene Ist- Verfahrbahn stellt lediglich eine Ab- Die Soli- Vorhalteposition wird in einem weiteren Modus 
schatzung des Verlaufs der Soli- Verfahrbahn dar und muss (Parameter-Mode) vor der Regelung der \brhalteposition 
so genau sein, dass sie fur eine vorausschauende Regelung angefahren. Zum An f ahren der Soil- Vorhalteposition im Pa- 
der Vorhalteposition des Manipulators entlang der Verfahr- rameter-Mode werden die im Record-Mode gespeicherten 
bahn herangezogen werden kann. 20 Punkte der Ist- Verfahrbahn herangezogen. Sobald die Soil- 
Die Ist- Verfahrbahn wird vorteilhafterweise von dem Ma- \brhalteposition erreicht ist, beginnt eine Trainingsphase, in 
nipulator vor der Regelung der Vorhalteposition von einer der fur die spatere, im Rahmen des Operation-Mode durch- 
internen Steuerungseinrichtung des Handhabungsgerats ge- gefiihrte Regelung der Vorhalteposition benotigte Informa- 
steuert abgefahren. Auf der intemen Steuerungseinrichtung tionen ermittelt werden. ^ 

lauft ein Steuerungsprogramm ab, in dem die einzelnen 25 Wahrend der Trainingsphase wird der Manipulator um 

Punkte der Ist- Verfahrbahn programmiert sind. Das Steue- die Soil- Vorhalteposition um jeweils einen Freiheitsgrad in 

rungsprogramm steuert das Handhabungsgerat derart an, unterschiedliche Vorhaltepositionen relativ zu dem Objekt 

dass der Manipulator wahrend des Ablaufs des Steuerungs- bewegt Der Manipulator wird um jeden Freiheitsgrad in., 

programms die Ist- Verfahrbahn abfahrt Dabei werden die Vorhaltepositionen bewegt, die vorzugsweise zu beiden Sei- 

Punkte zumindest eines Teils der Ist- Verfahrbahn aufge- 30 ten der Soil- Vorhalteposition liegen. Die Vorhaltepositionen 

nommen und abgespeichert AuBer den in dem Steuerungs- des Manipulators werden durch Sensoren ermittelt, die vor- 

programm programmierten Punkten der Ist- Verfahrbahn zugsweise an dem Manipulator befestigt sind. Die Sensoren 

konnen noch zusatzliche Punkte der Ist- Verfahrbahn aufge- liefem Messdaten anhand derer eine Vorhalteposition des 

nommen und gespeichert werden. Manipulators charakterisiert ist. Die Messdaten sind bspw. 

Die Punkte zumindest eines Teils der Ist- Verfahrbahn 35 die Abstande von den Sensoren zu dem Objekt, Krafte oder 

werden vorzugsweise von einer externen Regelungseinrich- Momente, die von dem Objekt auf die Sensoren einwirken. 

tung aufgenommen und abgespeichert Auf der externen Re- Die Messdaten konnen auch Bildmessdaten sein. Bildmess- 

gelungseinrichtung lauft ein Regelungsprogramm ab, das daten werden durch Verraessen von Bildem gewonnen, die 

die Vorhalteposition des Manipulators auf der Verfahrbahn von einer CCD-Kamera o. a. aufgenommen wurden. Im 

regelt Die externe Regelungseinrichtung ist bspw. ais ein 40 Rahmen der Trainingsphase werden die Messdaten fur jeden 

Personal Computer (PC) oder als ein Industrie-PC ausgebil- der Freiheitsgrade fur jede der Vorhaltepositionen aufge- 

det Das Regelungsprogramm kann in einer Standard-Pro- nommen. Es ist denkbar, dass die gespeicherten Messdaten 

grammiersprache programmiert und ohne groBen Aufwand fur die Regelung der Vorhalteposition weiterverarbeitet wer- 

umprogrammiert werden. In einem bestimmten Modus (Re- den. Dann ist die Trainingsphase fur diese Soll-Ybrhaltepos- 

cord-Mode) vor der Regelung der Vorhalteposition kann das 45 ition abgeschlossen. Der Manipulator kann eine weitere 

Regelungsprogramm auch die Punkte der von dem Manipu- Soil- Vorhalteposition anf ahren und fur diese Soll-Vorhalt- 

lator abgefahrenen Ist- Verfahrbahn aufnehmen und abspei- eposition eine weitere Trainingsphase durchlaufen, bis alle 

chem. Die gespeicherten Punkte werden dann in einem an- Soli- Vorhaltepositionen angefahren worden sind. Dann ist 

deren Modus (Operation-Mode) fur die vorausschauende der Parameter-Mode abgeschlossen. Die spatere, im Rah- 

Regelung der Vorhalteposition herangezogen. 50 men des Operation-Mode durchgefuhrte Regelung der Vor- 

GemaB einer anderen vorteilhaften Weiterbildung der halteposition wird in Abhangigkeit von den gespeicherten 

vorhegenden Erfindung wird vorgeschlagen, dass die ex- Messdaten durchgefuhrt 

teme Regelungseinrichtung von der intemen Steuerungsein- Bei dem erfindungsgemafien verfahren ersetzt die Trai- 

richtung aufgerufen wird. Das Steuerungsprogramm der in- ningsphase das bei herkommlichen, aus dem Stand der 

temen Steuerungseinrichtung ist ublicherweise in einer pro- 55 Technik bekannten Verfahren zum Regeln der Vorhaltepos- 

prietaren, nur auf der Steuerungseinrichtung eines bestimm- ition des Manipulators eines Handhabungsgerats notwen- 

ten Handhabungsgerats lauffahigen Programmieningsspra- dige Einrichten (Positionierung der Sensoren relativ zu dem 

che programmiert Es ware nur mit einem groBen Aufwand Objekt) und Kalibrieren (Einstellen der Parameter der Rege- 

moglich, das gesamte Regelungsprogramm in das Steue- lung). 

rungsprogramm zu integrieren. Deshalb sind in dem Steue- 60 Auch bei diesem Verfahren, bei dem vor der Regelung der 

rungsprogramm bestimmte Program mierbefehle (Aufrufbe- Vorhalteposiuon eine Trainingsphase durchlaufen wird, 

fehle, Ruckholbefehle) vorgeseheu, um das Regeiungspro- werden mehrere Punkte zumindest eines Teils der Ist-Ver- 

gramm der externen Regelungseinrichtung von dem Steue- fahrbahn gespeichert und fur eine vorausschauende Rege- 

ningsprogramm aus aufzurufen. Das Einfugen dieser Pro- lung der Vorhalteposition des Manipulators entlang dieses 

grammierbefehle in das Steuerungsprogramm ist mit einem 65 Teils der Verfahrbahn herangezogen. Das Durchlaufen einer 

geringen Aufwand moglich. Je nach dem in welchem Mo- Trainingsphase vor der Regelung der Vorhalteposition hat 

dus die Regelung betrieben wird, werden durch einen Auf- die angegebenen Vorteile aber auch ohne diese Merkmale 

ruf des Regelungsprogramms der Regelungseinrichtung die des Kennzeichens des Patentanspruchs 1. Der Schutz des 
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Patents soil sich deshalb auch auf ein Verfahren der zuletzt sate eines sequentiellen Kalmanfitters. Derartigc geeignete 

genannten Ait beziehen, bei dem die im Kennzeichen des Verfahren zum Berechnen des Konekturvektors sind aus 

Patentanspruchs 1 genannten Merkmale fehlen. dem Stand der Technik bekannt und konnen von einem 

GemaB einer bevorzugten Ausfuhrungsform der vorlie- Fachmann nach Belieben eingesetzt werden. Diese anderen 

genden Erfindung wird vorgeschlagen, dass vor der Rege- 5 geeignelen Verfahren haben den Vbrteil, dass auf eine relativ 

lung der \brhaiteposition aufwendige Bildung des Kehrwerts der Gradientenmatrix 

verzichtet werden kann. 

- die Soli- Vorhalteposition angefahren wird, Wahrend des Operation-Mode fahrt der Manipulator zu- 

- ein Soll-Messvektor mit den Messdaten aufgenom- nachst die Verfahrbahn gemafi den wahrend des Record- 
men wird, 10 Mode gespeicherten Punkten ab. Diese Verfahrbahn wird 

- fur jeden Freiheitsgrad der Manipulator des Handha- dann im Rahmen der Regelung der Vbrhalteposition des Ma- 
bungsgerats aus der Soli- Vorhalteposition heraus in nipulators mit Hilfe des Korreklurvektors korrigiert Bei 
mehrere Vorhaltepositionen bewegt und in jeder Vfor- dem erfindungsgemafien Verfahren wird die Vorhaltepos- 
halteposition ein Messvektor aufgenommen wird, ition also nicht absolut, sondern lediglich relativ zu einer 

- fur jeden Freiheitsgrad fiir dieseiben Messdaten der 15 Vorhalteposition auf der gespeicherten Verfahrbahn gere- 
Messvektoren der Betrag des Gradienten ermittelt und gelt. 

in einer Gradientenmatrix gespeichert wird, und im Vorteilhafterweise wird die 1st- Vorhalteposition im Rah- 

Rahmen der Regelung der Vorhalteposition men der Regelung der Vorhalteposition um einen Bruchteil 

- ein Korrekturvektor aus der Multiplikation des des Korreklurvektors korrigiert und anschlieBend der Ist- 
Kehrwerts der Gradientenmatrix mit der Differenz des 20 Messvektor in der korrigierten Isfc Vorhalteposition und dar- 
Soll-Messvektors und eines Ist-Messvektors in der 1st- aus der Korrekturvektor erneut ermittelt Die Ist-Vorhalt- 
Vorhalteposition des Manipulators oder anhand eines eposition wird also nicht um den gesamten Korrekturvektor 
anderen geeigneten Verfahrens ermittelt wird und korrigiert Um ein Uberschwingen der Regelung zu verhin- 

- die Vorhalteposition in Abhangigkeit von dem Kor- dern, wird vielmehr versuct^ sich der Soli- Vorhalteposition 
rekturvektor geregelt wird 25 langsam von einer Richtung her anzunahern. Dadurch wird 

eine Regelung mit einem gedampften Einschwingverhalten 

GemaB dieser bevorzugten Ausfuhrungsform werden in realisiert Durch eine geeignete Wahl des Bruchteils des 

der TYainingsphase im Parameter-Mode die fiir die Soil- Vor- Korrekturvektors kann die Dampfungskonstante der Rege- 

halteposition aufgenommenen Messdaten in einem Soli- lung bestimmt werden. 

Messvektor und die Messdaten, die fur im Rahmen der Trai- 30 Die Regelung der Vorhalteposition wird vorzugsweise ab- 

ningspbase angefahrene Vorhaltepositionen aufgenommen gebrochen, wenn jedes der Elemente des Korrekturvektors 

wurden, in Messvektoren gespeichert Fiir jeden Freiheits- kleiner als ein Abbruchkriterium ist Durch eine geeignete 

grad, um den der Manipulator bewegbar ist, werden also von Wahl des Abbruchkriteriums kann einerseits die Genauig- 

der Soll-\forhalteposition aus mehrere Vorhaltepositionen in keit der Regelung und andererseits die Regelungsgeschwin- 

jede Richtung angefahren und in jeder Vorhalteposition ein 35 digkeit bestimmt werden. Je kleiner der Wert des Abbruch- 

Messvektor aufgenommen. Die Dimension der Messvekto- kriteriums gewahlt wird, desto genauer kann die Regelung 

ren entspricht der Anzahl der fur jede Vorhalteposition auf- der Vorhalteposition durchgefuhrt werden. Ein kleiner Wert 

genommenen Messdaten. Die Dimension aller Messvekto- des Abbruchkriteriums bedeutet jedoch auch, dass die Rege- 

ren ist gleich groB. lung mehr Zeit bendtigt, bis das Abbruchkriterium erfullt 

Fur jeden Freiheitsgrad werden die Messvektoren und der 40 ist 

Soll-Messvektor dann weiterverarbeitet Aus denselben Um eine Regelbarkeit der Vorhalteposition des Manipula- 

Messdaten der Messvektoren eines Freiheitsgrades wird der tors innerhalb eines bestimmten Arbeitsvolumens der Rege- 

Betrag des Gradienten ermittelt und in einer Gradientenma- lung sicherzustellen, sollten die aufgenommenen Messvek- 

trix gespeichert Die Gradientenmatrix hat somit die Dimen- toren nach Moglichkeit das gesamte Arbeitsvolumen abdek- 

sionen (Anzahl der fur jede Vorhalteposition aufgenomme- 45 ken. Des Weiteren sollten fur jeden Freiheitsgrad so viele 

nen Messdaten) x (Anzahl der Freiheitsgrade). Es ist denk- Messvektoren aufgenommen werden, dass eine zuverlassige 

bar, den Kehrwert der Gradientenmatrix bereits in dem Pa- Berechnung des Betrags des Gradienten der Messdaten 

rameter-Mode zu berechnen und abzuspeichem. Vorzugs- moglich ist. Deshalb wird gemafi einer bevorzugten Ausftih- 

weise wird er aber erst in dem nachfblgenden Operation- rungsform der Erfindung vorgeschlagen, dass fur jeden Frei- 

Mode berechnet Damit ist die Train ingsphase fiir diese 50 heitsgrad von der Soli- Vorhalteposition aus mindestens zwei 

Soil- Vorhalteposition abgeschlossen. Die Gradientenmatrix Messvektoren in jede Richtung aufgenommen werden. Vor- 

kann auch als Jakobimatrix oder als Sensibilitatsmatrix be- teilhafterweise werden jedoch fur jeden Freiheitsgrad von 

zeichnet werden. der Soli- Vbrhalteposition aus funf Messvektoren in jede 

Im Rahmen des Operation-Mode wird dann fur die Rege- Richtung aufgenommen. Somit ergeben sich fur jeden Frei- 

lung der Vorhalteposition des Manipulators ein Ist-Mess- 55 heitsgrad zehn Messvektoren und der Soll-Messvektor, also 

vektor ermittelt, d. h. es werden die Messdaten in der mo- elf Messvektoren. Fur jedes der aufgenommenen und in den 

mentanen vbrhalteposition des Manipulators des Handha- Messvektoren gespeicherte Messdatum wird dann der Be- 

bungsgerats ermittelt und in dem Ist-Mess vektor gespei- trag des Gradienten berechnet und in der Gradientenmatrix 

chert Dann wird ein Differenzvektor aus der Differenz des abgespeichert 

Soll-Messvektors und des Ist-Messvektors gebildet Des 60 Die Messvektoren mussen zusammen fur jeden Freiheits- 

Weiteren wird der Kehrwert der Gradientenmatrix berechnet grad, in dem die Vorhalteposition des Manipulators des 

und wahlweise abgespeichert Handhabungsgerats geregelt wird, mindestens ein unabhan- 

Schliefilich wird ein Korrekturvektor aus der Multiplika- giges Messdatum enthalten. GemaB einer weiteren bevor- 

tion des Kehrwerts der Gradientenmatrix mit dem Diflfe- zugten Ausfuhrungsform der Erfindung wird vorgeschlagen, 

renzvektor berechnet und die \forhalteposition in Abhangig- 65 dass die Messvektoren zusammen mindestens sechs Mess- 

keit von dem Korrekturvektor geregelt ^ dalen enthalten. Dadurch kann die Position und Ausrichtung 

Der Korrekturvektor kann auch mittels eines anderen ge- des Manipulators relativ zu dem Objekt in sechs FreiheiLs- 

eigneten Verfahrens bestimmt werden, bspw. durch den Ein- graden eindeutig charakterisiert werden. Damit kann die 
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Vorhalteposilion des Manipulators urn sechs Freiheitsgrade 
im dreidimensionalen Raum geregelt werden. Vbrzugsweise 
enthalten die Messvektoren jeweils 32 Messdaten. 

Eine weitere Aufgabe der vorliegendcn Erfindung besteht 
darin, cine Vorrichtung der eingangs genannten Art dahinge- 5 
hend auszugestalten und weiterzubilden, dass eine m6g- 
iichst schnelle Regelung der Vorhalteposilion erreicht und 
dass insbesondere hdhere Verfahrgescbwindigkeiten des 
Manipulators auf der Verfahrbahn realisiert werden konnen, 
ohne dass es zu einem Verlust an Regelungsgenauigkeit 10 
kommt 

Zur Losung dieser Aufgabe schlagt die Erfindung ausge- 
bend von der Vforrichtung der eingangs genannten Art vor, 
dass die Vorrichtung Mittel zur Durchfuhrung des Verfah- 
rens nach einem der Anspriiche 1 bis 13 aufweist 15 

Eine weitere Aufgabe der vorliegenden Erfindung besteht 
schlieBlich darin, ein Handhabungsgerat der eingangs ge- 
nannten Art dahingehend auszugestalten und weiterzubil- 
den, dass eine moglichst schnelle Regelung der Vorhaltepos- 
ition erreicht und dass insbesondere hdhere Verfahrge- 20 
schwindigkeiten des Manipulators auf der Verfahrbahn rea- 
lisiert werden konnen, ohne dass es zu einem Verlust an Re- 
gelungsgenauigkeit kommL 

Zur Losung dieser Aufgabe schlagt die Erfindung ausge- 
hend von dem Handhabungsgerat der eingangs genannten 25 
Art vor, dass das Handhabungsgerat Mittel zur Durchfuh- 
rung des Verfahrens nach einem der Anspriiche 1 bis 13 auf- 
weisL 

Die erfindungsgemafie Vforrichtung und das erfindungsge- 
mafie Handhabungsgerat weisen insbesondere Mittel auf, 30 
urn in einem Record-Mode mehrere Punkte zumindest eines 
Teils der 1st- Verfahrbahn zu speichem und die gespeicherten 
Punkte dann in einem Operation-Mode fur eine voraus- 
schauende Regelung der Vorhalteposition des Manipulators 
entlang dieses Teils der Verfahrbahn heranzuziehen. Des 35 
Weiteren weisen die erfindungsgemafie Vorrichtung und das 
erfindungsgemafie Handhabungsgerat Mittel auf, um in ei- 
nem Parameter-Mode im Rah men einer Trainingsphase den 
Manipulator in eine Soli- Vorhalteposition zu fahren, um den 
Manipulator um die einzelnen Freiheitsgrade des Handha- 40 
bungsgerats in andere Vorhaltepositionen zu verfahren und 
fur jeden Freiheitsgrad in jeder Vorhalteposition die Mess- 
daten aufzunehmen und zu speichem, durcb die die entspre- 
chende Vorhalteposition charakterisiert ist 

Bei der erfindungsgemafien Vforrichtung und dem erfin- 45 
dungsgemafien Handhabungsgerat kann die Verfahrge- 
schwindigkeit des Manipulators aufgrund der vorausschau- 
enden Regelung besonders grofi gewahlt werden. Aufierdem 
. ersetzt die Trainingsphase das Einrichten und Kalibrieren 
der Sensoren. Mil der erfindungsgemafien Vorrichtung und 50 
dem erfindungsgemafien Handhabungsgerat ist somit eine 
schnellere Regelung der Vorhalteposition moglich, ohne 
dass es zu einem Verlust an Regelungsgenauigkeit kommt 

Gemafi einer vorteilhaften Weiterbildung der vorliegen- 
den Erfindung wird vorgeschlagen, dass an dem Maniputa- 55 
tor des Handhabungsgerats zur Ermittlung der 1st- Vorhalt- 
eposition des Manipulators relativ zu dem Objekt minde- 
stens ein Sensor befestigt ist 

Der oder jeder Sensor ist vorteilhafterweise derart relativ 
zu dem Objekt angeordnet, dass die Folge der Messdaten 60 
der fur einen Freiheitsgrad aufgenommenen Messvektoren 
streng monoton ist Dies ist eine wichtige Voraussetzung, 
um den Manipulator aus alien Positionen und Ausrichtun- 
gen relativ zu dem Objekt stets in die gewunschte Soil- Vor- 
halteposition regeln zu konnen. 65 

Des Weiteren muss die Beobachtbarkeit der Regelung si- 
chergestellt sein. Deshalb wird gemafi eineranderen vorteil- 
haften Ausfuhrungsform der Erfindung vorgeschlagen, dass 
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der oder jeder Sensor derart relativ zu dem Objekt angeord- 
net ist, dass in der Gradientenmatrix fur jeden Freiheitsgrad 
jeweils fur mindestens einen aufgenommenen Messdaten 
ein Gradienten-Betragswert enthalten ist 

Damit die in der Gradientenmatrix im Rah men der Rege- 
lung der Vorhalteposition auch verarbeitet werden konnen, 
und zu einem zuverlassigen Ergebnis fiihren, wird vorge- 
schlagen, dass der oder jeder Sensor derart relativ zu dem 
Objekt angeordnet ist, dass die Gradienten-Betragswerte in 
der Gradientenmatrix significant sind Man spricht von si- 
gnifikanten Gradienten-Betragswerten, wenn diese von dem 
Messrauschen der aufgenommenen Messdaten unterscheid- 
bar sind. Die Gradienten-Betragswerte sind bspw. unter- 
scheidbar, wenn sie etwa doppelt so grofi sind wie das Mess- 
rauschen der aufgenommenen Messdaten. Falls die Gra- 
dientenstarke nicht ausreichend grofi ist, wird der entspre- 
chende Gradienten-Betragswert als nicht vorhanden gewer- 
tet. Die Gradienten-Betragswerte in der Gradientenmatrix 
sind vorzugsweise in etwa mindestens dreimal so grofi wie 
das Messrauschen. 

Die Kriterien der Monotonie der Folge der Messdaten, 
der Beobachtbarkeit der Regelung und der Gradientenstarke 
konnen durch die Position der Sensoren relativ zu dem Ma- 
nipulator beeinflusst werden. Der genaue Bezug der Senso- 
ren zu dem Manipulator is'ftllerdings von untergeordneter 
Bedeutung, solange die o. g. Kriterien erfullt sind. Der Be- 
zug der Sensoren zu dem Manipulator wird wahrend der 
Trainingsphase erfasst und uber die aufgenommenen und 
abgespeicherten Messdaten in der Regelung berucksichtigt. 

Gemafi einer bevorzugten AusfUhrungsform der vorlie- 
genden Erfindung wird vorgeschlagen, dass der oder jeder 
Sensor als ein optischer Sensor, insbesondere als eine CCD- 
Kamera, ausgebildet ist Mittels CCD-Kameras kann ein 
Objekt auf vielfaltige Weise charakterisiert werden. Es ist 
denkbar, dass die Messdaten bei als CCD-Kameras ausge- 
bildeten Sensoren als Abstande zwischen den Sensoren und 
dem Objekt, als Pixel auf dem CCD-Chip o, a. ausgebildet 
sind. CCD-Kameras haben zudem den Vorteii, dass ihr 
Blickfeld zum Ausrichten der Sensoren relativ zu dem Ob- 
jekt auf einem Bildschirm dargestellt werden kann. Das er- 
leichtert die Ausrichtung der Sensoren erheblich. 

Ein bevorzugtes Ausfuhrungsbeispiel der vorliegenden 
Erfindung wird im Folgenden anhand der Zeichnung naher 
erlautert Es zeigt 

Fig. 1 ein erfindungsgemafies Handhabungsgerat gemafi 
einer bevorzugten Ausfuhrungsform; 

Fig. 2 den Manipulator des Handhabungsgerats aus Fig. 1 
im Ausschnitt; und 

Fig. 3 eine Verfahrbahn eines erfindungsgemafien Hand- 
habungsgerats. 

In Fig. 1 ist ein erfindungsgemafies Handhabungsgerat in 
seiner Gesamtheit mit dem Bezugszeichen 1 gekennzeich- 
net Das Handhabungsgerat 1 weist einen Manipulator 2 auf, 
der in sechs Freiheitsgraden (x, y, z, a, b, c) bewegbar ist 
Das Handhabungsgerat 1 ist bspw. als ein Indus trie- Roboter 
ausgebildet, dessen Manipulator 2 bspw. als ein beliebiges 
Werkzeug oder als ein Messkopf zur Aufhahme beliebiger 
MessgrdBen (Temperatur, Abstand, etc.) ausgebildet ist 

Damit der Manipulator 2 die ihm zugedachte Aufgabe er- 
fullen kann, muss er in eine definierte VfcMhalteposition (vgl. 
Fig. 2) relativ zu einem Objekt 3 gebracht werden. Unter 
dem Begriff Vorhalteposition wird gemafi dem vorliegenden 
Patent auch die Ausrichtung des Manipulators 2 relativ zu 
dem Objekt 3 verstanden. Die Erfindung schlagt ein Verfah- 
ren zur Regelung der Vorhalteposition vor. Das erfindungs- 
gemaBe Verfahren kann nicht nur furjede Art von Pick-and- 
place-Anwendungen, sondern auch fur Anwendungen, bei 
denen einem bestimmten Linienverlauf gefolgt werden 
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muss, bspw. zum SchweiBen, Kleben oder Abdichten von werte der CCD-Chips der Sensoren 9 ausgebildet sind, auf- 

Kanten, eingeselzt werden. genommen und in Messvektoren gespeichert 

Gemafi dem vorliegenden Ausfiihrungsbeispiel soli cin Das erfindungsgemafie VerfahreQ zur Regelung der Vor- 

Schiebedach 4 eines Kraftfahrzeugs von dem Manipulator 2 halteposition des Manipulators 2 relativ zu dem Objekt 3 

ergriffen und in eine entsprechende Offhung (Objekt 3) im 5 weist drei unterschiedliche Betriebszustande auf. In einem 

Dach 5 der Karosserie des Kraftfahrzeugs eingesetzt wer- ersten Betriebszustand, dem sog. Record-Mode, wird die 

den. Der Manipulator 2 ist als ein Saugnapf zum Greifen des Verfahrbahn A bis B (vgL Fig, 3) zu einer Vbrhalteposition 

Schiebedachs 4 ausgebildet Die Vorhalteposition ist eine hin und von der Vbrhalteposition weg von dem Steuerungs- 

Position oberhalb der Offhung, von der aus das Schiebedach programm der Steuerungseinrichtung 6 gesteuert abgefah- 

4 in einer geradlinigen, senkrechten Bewegung nach unten 10 ren. In dem Bereich der Verfahrbahn zwischen den Punkten 

in die Offhung bewegt werden kann. C und D liegt ein fur die Regelung interessanter Bereich mit 

Das Handhabungsgerat 1 weist eine interne Steuerungs- einem oder mehreren Vbrhaltepositionen des Manipulators 
einrichtung 6 auf. Auf der Steuerungseinrichtung 6 ist ein 2, die relativ zu dem Objekt 3 geregelt werden sollen. Wenn 
Steuerungsprogramm lauftahig, durch das der Manipulator der Manipulator 2 beim Abfahren der Verfahrbahn den 
2 entlang einer programmierten Verfahrbahn (vgL Fig. 3) in is Punkt C erreicht hat, wird das Regelungsprogramm der Re- 
die Vorhalteposition bewegt werden kann. Wenn das Objekt gelungseinrichtung 7 aufgerufen. Wahrend des gesteuerten 
3, im vorliegenden Ausfiihrungsbeispiel die Offhung im Abfahrcns der Verfahrbahn von dem Punkt C bis D werden 
Dach 5 der Karosserie des Kraftfahrzeugs, stets an derselben dann einer oder mehrere Punkte von dem Regelungspro- 
Position angeordnet ist, reicht eine solche Steuerung der gramm auf genommen und gespeichert. Wenn die Verfahr- 
Verfahrbahn bis zur Vbrhalteposition vollkommen aus. Falls 20 bahn den Punkt D erreicht hat, wird das Regelungspro- 
die Position des Objekts 3 jedoch gewissen Schwankungen gramm beendet Damit ist der Record-Mode beendet. Auf 
unterworfen ist, kann durch eine Steuerung alleine nicht die gespeicherten Punkte der Verfahrbahn wird dann in ei- 
mehr sichergestellt werden, dass eine bestimmte Vorhalt- nem dritten Betriebszustand der Regelung zugegriffen. 
eposition des Manipulators 2 relativ zu dem Objekt 3 stets In einem zweiten Betriebszustand, dem sog. Parameter- 
mit der erforderlichen Genauigkeit eingenommen winl 25 Mode, fahrt der Manipulator 2 von dem Steuerungspro- 
Schwankungen des Objekts 3 konnen sich bspw. aufgrund gramm gesteuert die Verfahrbahn von dem Punkt A zu dem 
von Ungenauigkeiten bei der Positionierung der Karosserie Punkt C ab. Wenn die Verfahrbahn den Punkt C erreicht hat, 
relativ zu dem Handhabungsgerat 1 oder aufgrund der Be- wird das Regelungsprogramm aufgerufen, und die Steue- 
wegung der Karosserie des Kraftfahrzeugs auf einer Ferti- rung des Manipulators 2 wird von dem Steuerungspro- 
gungsstraBe ergeben. 30 gramm an das Regelungsprogramm abgegeben. Das Rege- 

Um sicherzustellen, dass die Vorhalteposition des Mani- lungsprogramm fahrt die gespeicherte Verfahrbahn zwi- 

pulators 2 relativ zu dem Objekt 3 auch bei Schwankungen schen den Punkten C und D ab. Auf der Verfahrbahn werden 

der Position des Objekts 3 stets mit der geforderten Genau- diejenigen Vorhaltepositionen angefahren, die relativ zu 

igkeit eingenommen wird, wird in solchen Fallen die \for- dem Objekt geregelt werden sollen, und fur jede \forhalt- 

halteposition des Manipulators 2 relativ zu dem Objekt 3 ge- 35 eposition wird eine Trainingsphase durchlaufen, Wenn die 

regelt Aus dem Stand der Technik sind mehrere Verfahren von dem Regelungsprogramm gesteuerte Verfahrbahn den 

zur Regelung der \forhalteposition des Manipulators 2 be- Punkt D erreicht hat, wird das Regelungsprogramm beendet 

kannt Diese Verfahren sind jedoch sehr arbeits- und zeitauf- und die Steuerung des Manipulators 2 entlang der Verfahr- 

wendig. bahn wieder an das Steuerungsprogramm zuriickgegeben. 

Das erfindungsgemafie Verfahren zur Regelung der Vor- 40 Der Manipulator 2 fahrt dann von dem Steuerungspro- 
halteposition des Manipulators 2 weist verschiedene Merk- gramm gesteuert die restliche Verfahrbahn von dem Punkt D 
male zur Beschleunigung und Vereinfachung der Regelung bis B ab. Damit ist der Parameter-Mode beendet 
auf. Das Verfahren ist auf einer extemen Regelungseinrich- Fiir jede Vorhalteposition, die relativ zu dem Objekt 3 ge- 
tung 7 implementiert (vgL Fig. 1). Die Regelungseinrich- regelt werden soil, wird eine Trainingsphase durchgefuhrt 
rung 7 ist als ein herkommlicher Personal-Computer (PC) 45 Dazu wird zunachst die Soil- Vorhalteposition mit dem Ma- 
oder Industrie-PC ausgebildeL Auf der Regelungseinrich- nipulator 2 angefahren, und von den Sensoren 9 werden die 
rung 7 ist ein Regelungsprogramm, das in einer herkbmmli- Werte von 32 Messdaten, durch die die Soli- Vorhaltepos- 
chen Programmiersprache programmiert ist, lauffahig. In ition charakterisiert ist, aufgenommen und in einem Soil- 
Fig. 1 ist die Regelungseinrichtung 7 als von dem Handha- Messvektor y„soil gespeichert Der Soil-Mess vektor y_soll 
bungsgerat 1 getrennt ausgebildet Es ist jedoch auch denk- 50 hat somit die Dimension 32 x 1 (32 Messdaten x 1 Wert), 
bar, dass die Regelungseinrichtung 7 in das Handhabungs- AnschlieBend wird der Manipulator 2 nacheinander um je- 
gerat 1 integriert ist Das Steuerungsprogramm der Steue- den der sechs Freibeitsgrade in funf Vorhaltepositionen in 
rungseinrichtung 6 ist in einer proprietaren, nur auf der der einen Richtung der Soil- Vorhalteposition und in funf 
Steuerungseinrichtung 6 dieses Handhabungsgerats 1 lauf- Vorhaltepositionen in der anderen Richtung der Soll-Vor- 
fahigen Programmiersprache programmiert Das Steue- 55 halteposition bewegt In jeder Vorhalteposition werden die 
rungsprogramm weist an bestimmten Stellen Programmier- entsprechenden Werte der 32 Messdaten aufgenommen und 
befehle (Aufrufbefehle, RQckholbefehle) auf, um das Rege- in Messvektoren gespeichert Aus den zehn Messvektoren 
lungsprogramm der extemen Regelungsvorrichtung 7 von und dem Soll-Messvektor y_soll wird dann fur jeden der 
dem Steuerungsprogramm aus aufzurufen bzw. um von dem sechs Freiheitsgrade der Betrag des Gradienten eines be- 
Regelungsprogramm wieder zu dem Steuerungsprogramm 60 stimmten Messdatums berechnet und in einer Gradienten- 
zuruckzukehren. Zwischen der Steuerungseinrichtung 6 und matrix C abgespeichert Die Gradientenmatrix C hat somit 
der Regelungseinrichtung 7 ist eine Datenleitung 8 zum die Dimension 32 x 6 (32 Messdaten x 6 Freiheitsgrade). 
Austausch von Daten vorgesehen. Fur jeden der zu regelnden vbrhaltepositionen erhalt man 

In Fig. 2 ist zu erkennen, dass an dem Manipulator 2 vier somit einen Soll-Messvektor y_soll und die Gradienten ma- 

als CCD-Karneras ausgebildete Sensoren 9 angeordnet sind. 65 trix C. 

Durch die Sensoren 9 werden die Veriaufe der Kanten 10 in In einem dritten Betriebszustand, dem sog. Operation- 
Relation zu dem Manipulator 2 gesetzt Dazu werden Mess- Mode, fahrt der Manipulator 2 von dem Steuerungspro- 
daten, die im vorliegenden Ausfuhrungsbeispiel als Pixel- gramm gesteuert die Verfahrbahn von dem Punkt A zu dem 
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Punkt C ab. Wenn die Verfahrbahn den Punkt C erreicht hat, 
wird das Regelungsprogramm aufgerufen, und die Steue- 
rung des Manipulators 2 wird von dem Steuerungspro- 
gramm an das Regelungsprogramm abgegeben. Das Rege- 
lungsprogramm fahrt die gespeicherte Vferfahrbahn zwi- 5 
schen den Punkten C und D ab. Die gespeicherten Punkte 
der Verfahrbahn erlauben eine vorausschauende Regelung 
der Vorhaltepunkte auf der Verfahrbahn, was bei gleicher 
oder sogar hoherer Genauigkeit eine wesentiich hohere \fer- 
fahrbahngeschwindigkeit als bei den aus dem Stand der to 
Technik bekannten Verfahren zum Regeln der Nforhaltepos- 
ition eines Manipulators ermoglicht 

In dem Bereich der Verfahrbahn zwischen den Punkten £ 
und F liegt ein fur die Regelung interessanter Bereich mit ei- 
nem oder mehreren Vorhaltepositionen des Manipulators 2, is 
die relativ zu dem Objekt 3 geregelt werden sollen. Sobald 
die Verfahrbahn den Punkt E erreicht hat, erfolgt eine Rege- 
lung der Vorhalteposition auf der Verfahrbahn. Im Rahmen 
der Regelung der Vorhalteposition werden von den Senso- 
ren 9 zunachst in der momentanen 1st- Vorhalteposition die 20 
entsprechenden Werte der Messdaten aufgenomrnen und in 
einem Ist-Messvektor y_ist gespeichert Der Ist-Messvektor 
y_ist hat ebenfalls die Dimension 32 x 1 (32 Messdaten X 1 
Wert). Aus der DifFerenz des Soll-Messvektors und des Ist- 
Messvektors wird ein DirTerenz-Messvektor D_y gebildet 25 
(D_y = y soli - yjst). Der DirTerenz-Messvektor D_y hat 
ebenfalls die Dimension 32 x 1. Dann wird der Kehrwert 
der Gradientenmatrix C berechnet und wahlweise abgespei- 
chert Aus dem Produkt des Kehrwerts des Gradientenvek- 
tors C und des Differenz-Messvektors D_y wird ein Korrek- 30 
turvektor D_x ermittelt, der ebenfalls die Dimension 32 x 1 
hat Es ist jedoch auch denkbar, dass der Korrekturvektor 
D_x mittels eines anderen geeigneten Verfahrens, bspw. 
durch den Einsatz eines sequentiellen Kalrnanfilters, ermit- 
telt wird. 35 

Ein Teil des Korrekturvektors D_x, vorzugsweise etwa 
10% des Korrekturvektors D_x, wird zur Korrektur der Ist- 
Vorhalteposition des Manipulators 2 herangezogen. In der 
neuen Ist- Vorhalteposition werden erneut die entsprechen- 
den Werte der Messdaten aufgenomrnen und in einem Ist- 40 
Messvektor y_ist gespeichert Wie oben bereits beschrieben 
wird erneut ein Korrekturvektor D_x berechnet und die Ist- 
Vorhalteposition in Abhangigkeit von dem Korrekturvektor 
D_x korrigiert Die Korrektur der Ist-\brhalteposition wird 
so lange wiederholt, bis die einzelnen Werte des Korrektur- 45 
vektors D_x ein bestimmtes Abbruchkriterium erfullt ha- 
ben, cL h. bis der Manipulator 2 auf die Soil- Vorhaltepos- 
ition geregelt ist 

Patentanspruche 50 

1. Verfahren zur Regelung der Vorhalteposition eines 
in mehreren Freiheitsgraden bewegbaren Manipulators 
(2) eines Handhabungsgerats (1) relativ zu einem Ob- 
jekt (3) entlang einer Verfahrbahn, dadurch gekenn- 55 
zeichnet, dass mehrere Punkte zumindest eines Teils 
der Ist- Verfahrbahn gespeichert sind und ftir eine vor- 
ausschauende Regelung der Vorhalteposition des Ma- 
nipulators (2) entlang dieses Teils der Verfahrbahn her- 
angezogen werden. 60 

2. Verfahren nach Anspruch 1, dadurch gekennzeich- 
net dass die Ist- Verfahrbahn des Manipulators (2) vor 
der Regelung der Vorhalteposition abgefahren wird 
und dabei die Punkte zumindest eines Teils der Ist-Ver- 

• fahrbahn aufgenomrnen und abgespeichert werden. 65 

3. Verfahren nach Anspruch 2, dadurch gekennzeich- 
net dass die Ist- Verfahrbahn von dem Manipulator (2) 
vor der Regelung der Vorhalteposition von einer inter- 
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nen Steuerungseinrichtung (6) des Handhabungsgerats 

(1) gesteuert abgefahren wird. 

4. Verfahren nach Anspruch 2 oder 3, dadurch gekenn- 
zeichnet, dass die Punkte zumindest eines Teils der Ist- 
Verf ahrbahn von einer extemen Regelungseinrkhtung 
(7) aufgenomrnen und abgespeichert werden. 

5. Verfahren nach Anspruch 3 und 4, dadurch gekenn- 
zeichnet, dass die externe Regdungseinrichtung (7) 
von der internen Steuerungseinrichtung (6) aufgerufen 
wird 

6. Verfahren zur Regelung der Vorhalteposition eines 
in mehreren Freiheitsgraden bewegbaren Manipulators 

(2) eines Handhabungsgerats (1) relativ zu einem Ob- 
jekt (3) entlang einer Verfahrbahn, insbesondere nach 
einem der Anspruche I bis 5, dadurch gekennzeichnet, 
dass die Soil- Vorhalteposition des Manipulators (2) vor 
der Regelung der Vorhalteposition angefahren wird, 
wahrend einer Veranderung der Soil- Vorhalteposition 
urn jeweils einen Freiheitsgrad Messdaten, durch die 
die Vorhalteposition des Manipulators (2) charakteri- 
siert ist, aufgenomrnen und gespeichert werden und die 
Regelung der Vorhalteposition in Abhangigkeit von 
den Messdaten durchgefuhrt wird. 

7. Verfahren nach Ansoruch 6, dadurch gekennzeich- 
net, dass vor der Regelung der \fcrhalteposition 

- die Soli- Vorhalteposition angefahren wird, 

- ein Soll-Messvektor (y_soll) mit den Messda- 
ten aufgenomrnen wird, 

- fur jeden Freiheitsgrad der Manipulator (2) des 
Handhabungsgerats (1) aus der Soll-Vorhaltepos- 

. ition heraus in mehrere Vorhaltepositionen be- 
wegt und in jeder Vorhalteposition ein Messvektor 
aufgenomrnen wird, 

- fur jeden Freiheitsgrad fur dieselben Messdaten 
der Messvektoren der Betrag des Gradienten er- 
mittelt und in einer Gradientenmatrix (C) gespei- 
chert wird, und im Rahmen der Regelung der Vor- 
halteposition 

- ein Korrekturvektor (D_x) aus der Multiplika- 
tion des Kehrwerts der Gradientenmatrix (Q mit 
der Differenz des Soll-Messvektors (y_soll) und 
eines Ist-Messvektors (y_ist) in der Ist- Vorhalt- 
eposition des Manipulators (2) oder anhand eines 
anderen geeigneten Verfahrens ermittelt wird und 

- die Vorhalteposition in Abhangigkeit von dem 
Korrekturvektor (D_x) geregelt wird, 

8. Verfahren nach Anspruch 7, dadurch gekennzeich- 
net, dass die Ist- Vorhalteposition des Manipulators (2) 
im Rahmen der Regelung der Vorhalteposition um ei- 
nen Bruchteii des Korrekturvektors (D_x) korrigiert 
wird und anschlieBend der Ist-Messvektor (y Jst) in der 
korrigierten Ist- Vorhalteposition und daraus der Kor- 
rekturvektor (D_x) erneut ermittelt wird. 

9. Verfahren nach Anspruch 8, dadurch gekennzeich- 
net, dass die Regelung der Vorhalteposition abgebro- 
chen wind, wenn jedes der Elemente des Korrekturvek- 
tors (D_x) kleiner als ein Abbruchkriterium ist 

10. Verfahren nach Anspruch 8 oder 9, dadurch ge- 
kennzeichnet, dass fur jeden Freiheitsgrad von der 
Soil- Vorhalteposition aus mindestens zwei Messvekto- 
ren in jede Richtung aufgenomrnen werden. 

11. Verfahren nach Anspruch 10, dadurch gekenn- 
zeichnet, dass fur jeden Freiheitsgrad von der Soll-\for- 
halteposition aus funf Messvektoren in jede Richtung 
aufgenomrnen werden. 

12. Verfahren nach einem der Anspruche 1 bis 5, da- 
durch gekennzeichnet dass die Messvektoren zusam- 
men mindestens sechs Messdaten enthalten, damit die 
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Position und Ausrichtung des Manipulators (2) relativ 
zu dem Objekl (3) im dreidimensionalen Raum charak- 
terisiert ist 

13. Verfahrcn nach Anspruch 12, dadurch gekenn- 
zeichnet, dass die Messvektoren jeweils 32 Messdaten 5 
enthalten. 

14. Vonichtung zur Regelung der \fcrhalteposition ei- 
nes in raehreren Freiheitsgraden bewegbaren Manipu- 
lators (2) eines Handhabungsgerats (1) relativ zu einem 
Objekt (3) endang einer Verfahrbahn, daduich gekenn- to 
zeichnet, dass die Vbrrichtung Mittel zur Durchruhrung 
des Verfahrens nach einem der Anspruche 1 bis 13 auf- 
weist 

15. Handhabungsgerat (1) mit einem inmehreren Frei- 
heitsgraden bewegbaren Manipulator (2), des sen Vor- 15 
halteposition relativ zu einem Objekt (3) regelbar ist, 
dadurch gekennzeichnet, dass das Handhabungsgerat 
(9) Mittel zur Durchfuhrung des Verfahrens nach ei- 
nem der Anspruche 1 bis 13 aufweist 

16. Handhabungsgerat (1) nach Anspruch 15, dadurch 20 
gekennzeichnet, dass an dem Manipulator (2) des 
Handhabungsgerats (1) zur Ermittlung der Ist-\forhalt- 
eposition des Manipulators (2) relativ zu dem Objekt 
(3) mindestens ein Sensor (9) befesligt ist. 

17. Handhabungsgerat (1) nach Anspruch 16, dadurch 25 
gekennzeichnet, dass der oder jeder Sensor (9) derart 
relativ zu dem Objekt (3) angeordnet ist, dass die Folge 
der Messdaten der fur einen Freiheitsgrad aufgenom- 
menen Messvektoren streng mono ton ist 

18. Handhabungsgerat (1) nach Anspruch 17, dadurch 30 
gekennzeichnet, dass in der Gradientenmatrix (C) fur 
jeden Freiheitsgrad jeweils fur mindestens ein aufge- 
nommenes Messdatum ein Gradienten-Betragswert 
enthalten ist. 

19. Handhabungsgerat (1) nach Anspruch 18, dadurch 35 
gekennzeichnet, dass die Gradienten-Betragswerte in 
der Gradientenmatrix (C) signifikant sind, 

20. Handhabungsgerat (1) nach einem der Anspruche 
15 bis 19, dadurch gekennzeichnet, dass der oder jeder 
Sensor (9) als ein optischer Sensor ausgebildet ist 40 

21. Handhabungsgerat (1) nach Anspruch 20, dadurch 
gekennzeichnet, dass der oder jeder Sensor (9) als eine 
CCD-Kamera ausgebildet ist 
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